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Abstract 


It is often proposed that the redundancy in choosing a force distribution 
for multiple arms grasping a single object should be handled by minimizing a 
quadratic performance index. The performance index may be formulated in terms 
of joint torques or in terms of the Cartesian space force/torque applied to the 
body by the grippers. The former seeks to minimize power consumption while the 
latter minimizes body stresses. Because the cost functions are related to each 
other by a joint angle dependent transformation on the weight matrix, it might 
be argued that either method tends to reduce power consumption, but clearly the 
joint space minimization is optimal. In this paper, a comparison of these two 
options is presented with consideration given to computational cost and power 
consumption. Simulation results using a two arm robot system are presented to 
show the savings realized by employing the joint space optimization. These 
savings are offset by additional complexity, computation time and in some cases 
processor power consumption. 


1. Introduction 

Some of the recent developments in multiple arm manipulation of a commonly 
grasped body include the work of Hayati [1], Alberts [2], and Carnignan [3]. 

The common thread between these papers is that each employs the minimization of 
some form of quadratic performance index to choose an appropriate load 
distribution. Hayati proposed an extension of Mason's [4] hybrid position/force 
control in which the inertia of each arm is artificially extended to include a 
portion of the payload inertia. From a practical point of view, the method may 
be difficult to implement effectively, because it requires precise knowledge of 
the inertial properties of the arms and of the jointly manipulated objects as 
well as the solution of inverse dynamics. Alberts closes a force feedback loop 
around a kinematic resolved rate controller for multiple arms, thus realizing 
the Damping Control Method. As in Hayati's work the problem of redundancy in 
determining the distribution of load among the manipulators is handled by 
minimizing a quadratic cost function in task-space force and torque. This tends 
to minimize internal forces in the body while maintaining control over a 
prescribed force and torque interaction with the external environment. Alberts 
formulation does not consider the closed chain dynamics of the manipulators and 
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payload, but rather each manipulator is viewed as an actuator with an 
independent control system. Carnignan used a quadratic cost function to 
minimize joint space torques including those due to manipulator kinetics but 
due to the inclusion of the manipulator kinetic effects, undesirable internal 
forces may be produced in the body. This method is computationally more 
expensive than task space optimization. 

It can be argued that minimizing a quadratic cost function in joint space 
has greater power efficiency than a minimization in task space, but at what 
computational cost? This paper compares the task space versus joint space cost 
functions with respect to power efficiency and computational cost. The 
development is to be based on Alberts' task space cost function and a joint 
space cost function developed along similar lines. The computational cost of 
using the joint space minimization scheme is similar to Carnignan's method. The 
torques required to compensate for manipulator kinetics are not included in the 
minimization so as to avoid imposing unnecessary internal forces and torques 
within the manipulated body. 

2. Power Cost Calculation 

In a multiarm robotic system, minimization of a joint torque based 
quadratic cost function would tend to minimize the dissipated power used by the 
motors under static conditions. 1 

A minimization scheme to establish an "optimal" force distribution could be 
formulated in either joint space or task space. From the standpoint of power 
used to drive the joints, it would be optimal to formulate the minimization in 
joint space. In this paper the question considered is that of how much power 
really can be saved by optimizing in joint space as opposed to task space. 

Based upon a task space quadratic performance index 

( 1 ) 

the task space optimal load distribution force equation [2] is 


where 


A t = W^VtHW-Vr 1 (3) 

and _T t is a vector of wrench vectors (as in Equation 15, Appendix I) such 
that each components F_(i) of r t is a wrench vector applied to the body at 
the grasp point of the i^h manTpulator and subscript t denotes task space. H 
is a matrix of Jacobian transformations that depends upon the locations of the 
grasp points of each arm relative to the applied external force F. The weight 

^To truly minimize power consumption under dynamic conditions the cost 
function should include a term representing the product of joint torque and 
joint velocity. This is discussed further later in reference to Equation (9). 
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matrix is given by Wt = diag (vj, V2 .«**»vn) where N is the number 
of arms and Vi is a diagonal weight matrix reflecting the relative cartesian 
end effector force and torque capabilities of the 1 '™ arm. 

Using a similar development (Appendix I) but, based upon a joint space 
quadratic performance index 

Q. = t T W.t (4) 

J J 

the joint space optimal load distribution force equation is 

r. -A.F (5) 

-J J- 

where 


A. = J" T H.“ 1 J” 1 H[HJ" T M 1 J“ 1 H' T ]“ 1 (6) 

JO J 

with Wj = diag (wj, W£, ...,wn) and wi is a diagonal matrix whose 
elements are the squares of the reciprocals of the relative joint torque 
capabilities of the i th arm. Subscript j denotes joint space. 

The cost function is an indication of power used since torque (t) is 
proportional to current and current squared is proportional to power 
dissipated. To compare power consumption on an equal basis the cost of task 
space optimized load distribution was evaluated in terms of the joint space cost 
function. Thus, for evaluative purposes, the torque-squared cost of executing 
the task space optimization scheme can be expressed as 



T t“j T t 


(7) 


where t^. = 


and the cost associated with joint space optimization is given by Equation (4), 
that is Qjj = Qj. The cost resulting from the joint space formulation will 
always be less than that of the task space formulation according to the above 
criterion. 


The power used by a motor is 


a i\ p* p 

Power = I^R + u)Tm + wT-j (8) 

where I a is the armature current 
R is the armature resistance 
Kg is the back emf constant 
Kj is the torque constant 
uj is the angular speed of the rotor 
Ti is the torque of the load 
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T m = T f + where Tf is constant friction 
and D is the viscous damping coefficient. 

The current I a is related to the dynamos of the motor by 

I, = 1 [(J m + J 1 + T m + T,] 

3 TT t m 1 nc m 1 


( 9 ) 


where J m is the motor inertia and J-| is the load inertia. Observe that 
in the joint space minimization presented here (7) minimizes the power due to 
the term I a ^R in (8) but does not account for the power associated with 
wT] in the last term of (8). From a practical point of view it appears that 
the contribution of this term will normally be small. In simulations conducted, 
in which the load velocity was 0.1 m/s, the wT] term resulted in power 
difference of less than 1%. 

The percent difference in power is defined as follows 

P M = » 100 (10l 


where P-^ and Pj represent the power used by task and joint space 
respectively. 

The power difference is 

P D = P t - Pj where P D is in watts (H) 

A simulation 2 was used with the system parameters of the NASA LTM 3 (given 
in Appendix III) to compute the power used by the two-arm LTM system in moving a 
4° lb. payload on Earth. The center of gravity of the object was at the grasp 
point of one of the arms. The two arms moved horizontally without rotating the 
object. For this trajectory Pp and Pjj were plotted in figures 1 and 2 
respectively. The initial Pj = 1093 watts. 


2 The simulation is a combination of ROBSIM (a full dynamics robot simulator 
developed by NASA LaRC) and user coded. Robsim simulated the robotics dynamics 
and the user code calculated the load distributed joint torques and costs. 

3 LTM is an acronym for the Laboratory Telerobotic Manipulator developed for 
NASA LaRC by Oak Ridge National Laboratory. The LTM is a seven-degree-of- 
freedom arm employing differential friction drive joints. For simplicity the 
differential joint drive are treated as conventional gear driven joints. 
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Figure 1. The difference between task space and joint space power comsumption. 
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Figure 2. The percentage of power saved with respect to the total power 
used In joint space. 
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3. Computational Cost Calculation 

In a real-time computer program it is desirable to keep computationally 
expensive operations to a minimum. The number of operations it takes to 
calculate task space and joint space load distribution are determined below. 

For this analysis the following assumptions are made: 

1. The manipulators grasp points are fixed while the body is in motion 
thus H remains a constant matrix. 

2. W does not change over the motion of the body. 

3. All manipulators have the same number of degrees of freedom. 

In task space A is constant thus requiring only a matrix vector multiply to 
calculate r t . a is a 6N x 6 matrix where N is the number of manipulators 
grasping the body, and F is a 6 x 1 vector needing: 

36N multiplies; 

30N additions 
to calculate r^. 

Joint space will have the same operations as above plus the operations to 
calculate A. The total number of operation needed to calculated xi as 
derived in Appendix II is: J 

N(48n + 72) + 195 multiplies 
71 divides 

N(48n + 30) + 206 additions 

With the need to calculated the jacobian inverse the total number of operations 
to calculate rj as derived in Appendix II is: 

N(60n + 267) + 195 multiplies 

71N + 71 divides 

N(58n + 236) + 206 additions 

Currently the most powerful space qualified procesor is the Harris 80C86. Based 
on using this processor with a 5 mhz clock and the number of arms and degrees of 
freedom (DOF), the results Table I, II, and III are obtained. The entries in 
the tables represent the number of times the computation can be executed in 1 
second. 
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Number of Arms 



2 

3 

4 

6 

17.5 

12.4 

9.54 

7 

16.4 

11.5 

8.86 

8 

15.3 

10.7 

8.27 


Joint Space with Jacobian Inverse Calculated 

Table I 


436 


i 




2 

3 

4 

6 

29.8 

21.9 

17.3 

7 

27.2 

19.8 

15.6 

8 

25.0 

18.1 

14.2 


Joint Space without Jacobian Inverse Calculated 

Table II 
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2 

3 

4 

6 

413 

275 

206 

7 

413 

275 

206 

8 

413 

275 

206 


Task Space 
Table III 


The computational cost of task space optimization is small enough to execute the 
code on an existing processor whereas joint space optimization would likely 
require a separate processor. In this case the power required to operate 
additional processing equipment must be considered. The power requirement of an 
64K 80C86 board based on Harris radiation hardened components is 30 watts. 


4. Summary 

It has been shown that an apparently significant amount of power can be 
saved by employing the joint space optimized load distribution. In the example 
presented the largest savings over task space optimization realized was about 25 
watts. This can be viewed as an extreme case. It is important to note, 
however, that the joint space optimization represents a substantial increase in 
computational burden. If this results in a need for additional processors, the 
power required to operate them might offset the savings realized by the 
optimization scheme. 

In the future, space qualified processors will be available that are much 
more powerful and possibly more power efficient than those now used. In the 
case where a surplus of efficient computing power is available, the joint space 
optimization may prove to be the method of choice. 
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Appendix I 


5. Joint Space Optimal Load Distribution 

Assume that a desired net cartesian space wrench vector F acting on the 
body with known point of application p is specified. The wrench vector is 
made up of cartesian space force f and moment m vectors such that 



This wrench could be to counteract gravitational loading or inertial reactions 
due to body acceleration, or to apply a force to the external environment 
through the jointly manipulated object. Now consider a system of N 
manipulators, where F(i) denotes a cartesian space wrench applied to the 
jointly manipulated body by the end effector of arm i. The following 
conditions must be satisfied in order to establish equilibrium: 

N N 

1 a l (13) and m = l ( m(i) + r (i) X f(i) ) (14) 

i =1 “ i=l “ “P ~ 

where f(i) and m(i) are the force and moment vectors, respectively, that 
make up F( i ) 


F(i) 


f (i ) 
m(i ) 


(15) 


and £p(i) is a vector drawn from the point of application p of the force 
f_ to the grasp point for manipulator i. The minimization procedure operates on 
a quadratic function Q in the vector t, with positive definite symmetric 
weighting matrix W 


0 = t T W T 

where 


T 



J T 1 


s the jacobian transpose of the manipulator 


r = 


F(l) 

F(N) 


and W = diag (Wj, w 2 , ... , w N ) 


Conditions (13) and (14) are expressed in matrix form as 


(16) 


(17) 
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I 0 


I 0 


I. 


I 0 


[r (1)X]| I 3 


[r p ( 2 ) X ] j I 3 


[r (N)X] f I 3 

P I 



>(!)' 

» 


F(N) 


(18) 

F 


where, I 3 is a 3 by 3 identity matrix and [rp(i)X] is a matrix that 
operates on f ( i ) to form the cross product _Tp(i)X _f(i). A more compact 
expression for - (18) is 


HJ T x = F 


(19) 


Using a Lagrange multiplier X to append equation (19) to (16) the augmented 
cost function is obtained. 


Q = t T Wt - X T (HJ” T t - F) 

The optimal solution must satisfy 


( 20 ) 


= 0, that is 2 t T W - X T HJ _1 =0 (21) 

0 T 

Rearranging and applying equation (19) to equation (21) 

t = 1 HW~*J~*H^X which yields X = 2(HJ“^W”^J"^H^) *F_ (22) 

7 

Now upon eliminating X between equations (21) and (22) the final expression 
for joint torques is obtained. 

t = W" 1 J" 1 H T (HJ"V 1 J _ 1 H T )" 1 F = AF (23) 


Appendix II 

To count the operations in A it is necessary to first simplify A into 
two matrices A and B, such that 

where A = AB~1, A = and B = HA 

Calculating A: 


J - 1 j -1 
1 J 2 


,-l 


, w 


-1 


W -1 

W 1 W 2 A 


w; 


-l 
N J 


and H 1 


?i 

hJj 
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,-1 


where is the jacobian inverse for manipulator i. 


,-1 , 


Wj is the weight matrix inverse for manipulator i. 


and H i is the transform grasp point to controlled force F for 
manipulator i. 


so 


j- t k:W 

J 




0 J N w n 1 j n t hJ 


and 


B = HA 
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The cost to calculate j7'w7*J^hT is: 





r 

n x 6 


full 


matrix 


mm — 



0 


0 

1 1 

1 0 1 . 

at a cost of n*(6 multiplies + 6 additions) 


1 0 | o z -y 

1 -z o x 

0 1 ' y -x o 


1 




n x 6 

full 

matrix 


at a cost of n*6 multiplies 


6x6 
full 
matri x 

at a cost of n36 multiplies + (n-l)36 additions. The total cost of A is 
N[48n multiplies + (48n-36) additions]. 
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Calculating B: 

6x6 6x6 

B . = H.A. = full full 

1 1 matrix matrix 

at a cost of 36 multiplies 30 additions. Using triangular factorization to 
count the operation for B -1 , the cost is 195 multiplies 71 divides 206 
additions. Total cost for Aj is 

N(48n + 36) + 195 multiplies 
71 divides 

N(48n) + 206 additions 

To calculate the cost for a Tacobian inverse a generalized inverse formulation 
is used. Ji” 1 = Ji T [JiJi T ]"' 1 where Jf is the 6 x n 
jacobian for the ith manipulator and n is the degree of freedom of the 
manipulator. The cost is 12n + 6 multiplies 71 divides and lOn + 206 
additions giving a total cost for Aj with calculation of the jacobian 
inverse as 

N(60n + 231) + 195 multiplies 
7 IN + 71 divides 
N(58n + 206) + 206 additions 


Appendix III 

6. LTM System Parameters 

Motor constants (for all 7 joints) 

Torque Constant Kj 8.5 oz-in/A 

Back emf constant Kf 6.3 V/KRPM 

Armature resistance R 2.5 OHM 

Armature inertia J m 0.0015 oz-in-sec 2 

Viscous Damping D 0.3 oz-in-KRPM 

Static Friction Tf 0.8 oz-in 

Gear ratio from motor shaft to joint (assuming conventional gear driven joints) 


Joint 

1 

522 

Joint 

2 

522 

Joint 

3 

522 

Joint 

4 

522 

Joi nt 

5 

121 

Joi nt 

6 

121 

Joint 

7 

25 


Denavit and Hartenberg parameters 
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Denavi t-Hartenberg Parameters 
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Joint Inertia Matrix 


Link 

Number 

Inertia Matrix 
KG-M 

Orientation 
Matri x 

1 

0.029 0.0 0.0 

0.0 0.0145 0.0 

0.0 0.0 0.0145 

1.0 0.0 0.0 

0.0 0.0 -1.0 

0.0 1.0 0.0 

2 

0.029 0.0 0.0 

0.0 0.2989 0.0 

0.0 0.0 0.2989 

0.0 1.0 0.0 

0.0 0.0 1.0 

1.0 0.0 0.0 

3 

0.029 0.0 0.0 

0.0 0.0145 0.0 

0.0 0.0 0.0145 

1.0 0.0 0.0 

0.0 0.0 -1.0 

0.0 1.0 0.0 

4 

0.029 0.0 0.0 

0.0 0.2296 0.0 

0.0 0.0 0.2296 

0.0 -1.0 0.0 

0.0 0.0 1.0 

-1.0 0.0 0.0 

5 

0.0163 0.0 0.0 

0.0 0.0082 0.0 
0.0 0.0 0.0082 

1.0 0.0 0.0 

0.0 0.0 -1.0 

0.0 1.0 0.0 

6 

0.0163 0.0 0.0 

0.0 0.0269 0.0 

0.0 0.0 0.0269 

1.0 0.0 0.0 

0.0 0.0 1.0 

0.0 -1.0 0.0 

7 

0.0182 0.0 0.0 
0.0 0.0099 0.0 

0.0 0.0 0.0099 

0.0 -1.0 0.0 

0.0 0.0 1.0 

-1.0 0.0 0.0 


where the orientation matrix is referenced to the base of LTM. 
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